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(57) ABSTRACT 

An electronic cam servo apparatus uses a digital servo 
controller to perform motion equivalent to a mechanical 
cam. The control apparatus has one data table representing 
a characteristic of a mechanical cam and utilizes a data 
interpolation and the first derivative of a cam position profile 
to determine position and velocity commands lo drive a 
servo motor which performs motion equivalent to a 
mechanical cam. Alternatively, the control apparatus uses 
the first cam specific data table to determine the position, 
velocity and torque/current command to drive a servo motor 
The apparatus may additionally use a second data table 
representing varying cam load to obtain a more accurate 
torque/current command correction. 
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ELECTRONIC CAM CONTROL SYSTEM 

CROSS REFERENCE TO RELATED 
APPUCAnONS 

This application claims the benefit of U.S. Provisional 
ApplicatioQ No. 60/173,809, filed Dec. 30, 1999, which is 
hereby iacorporated by refereooe in its entirety. 

BACKGROUND OF THE INVENTION 

This invention relates generally to positioning 
mechanisms, and more specifically to electronically con- 
trolled cam servo control systems. 

At least one known electronic servo system includes a 
plurality of installed modules, typically referred to as input/ 
output (I/O) modules. In one application, an I/O module 
functions as a digital servo control module to perform 
precise, complex motion coordinated between two axes 
similar to a mechanical cam. 

A control system with a velocity and torquc/currcnt feed 
forward compensation is used to control speed and dynamic 
accuracy of motion. However, these systems arc complex 
and require large amounts of data storage. 

Accordingly, it would be desirable to provide a less 
complex electronic cam servo control system which delivers 
performance comparable to existing systems, is simpler for 
a user to operate, and requires less data storage space. 

BRIEF SUMMARY OF THE INVENTION 

In an exemplary embodiment, an electronic cam servo 
control system includes a processor, a digital servo control 
module capable of performing motion equivalent to a 
mechanical cam, an encoder, and a control program. A 
method for delivering high accuracy cam servo motion and 
simplifying cam motion applications in an electronic system 
includes importing a cam position profile and acquiring cam 
shaft position and velocity from an encoder interface. A cam 
servo position command is calculated using a cam position 
profile table. In addition, first derivatives of the cam position 
profile arc calculated. Cam shaft position and cam shaft 
velocity are acquired which allows a cam servo velocity 
compensation command to be calculated by multiplying the 
first derivative of the cam position profile by the cam shaft 
velocity. A cam position command and a cam velocity 
compensation command are then sent to the control module 
for execution. 

BRIEF DESCRIPTION OF THE DRAWINGS 

FIG. 1 is a schematic illustration of a known electronic 
system including a plurality of 1/0 modules; 

FIG. 2 is a flowchart detailing an exemplary electronic 
cam servo control system; 

FIG. 3 is a control system diagram that embodies the 
flowchart of FIG. 2; 

FIG. 4 is a control system diagram that has additional 
acceleration correction; 

FIG. 5 is a control system diagram that has additional 
current correction based on a table or formula; and 

FIG. 6 is a control system diagram where a cam position 
table has been replaced by a formula. 

DETAILED DESCRIPTION OF THE 
INVENTION 

FIG. 1 is a schematic illustration of an existing program- 
mable electronic cam servo control system 10. System 10 
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inchides a headend unit 12 and a plurality of modules 14, 
whidi for illustrative purposes are numbered Module 1 
through Module n and called input/output (I/O) modules. 
Headend unit 12 inchides a primary power supply 16, a 

s signal interconnection backplane 18, and a central process- 
ing unit (CPU) 20. I/O modules 14 include module bases 22, 
which further include input/output circuits 24 and an appli- 
cation specific integrated circuit (ASIC) 26. One such appli- 
cation of I/O module 14 is as a cam shaft encoder and digital 
servo controller. In a cam shaft encoder application, input/ 
output circuits 24 include an encoder interface. Although the 
invention is described in terms of system 10, it is to be 
understood that the invention can be practiced using other 
electronic cam servo control systems. 

j5 In the present invention, cam servo motion is delivered 
and cam motion applications are simplified using an elec- 
tronic cam servo control system. The electronic cam servo 
control system performs servo motor motion equivalent to a 
mechanical cam. The electronic cam servo control system 

20 utilizes a data table (not shown) which includes sets of data 
describing cam positioning characteristics. The data table 
contains pairs of cam shaft positions (master positions) and 
motor positions (slave positions) defining a cam profile. In 
most cases cam shaft positions and motor positions are the 

25 only data the tiser has to prepare a cam motion program. The 
electronic cam servo control system utilizes spline interpo- 
lation with continuous first derivative to generate interpo- 
lation coefficients. Coefficients are preprocessed and stored 
in a motion controller memory to reduce the amount of real 

30 time computations. 

FIG. 2 is a flowchart 30 showing the sequence of opera- 
tions used in an electronic cam implementation according to 
the present invention. A cam shaft position within one cam 
shaft revolution and cam shaft velocity are imported 32 from 

35 the encoder interface . A cam position command is calculated 
34 from a cam position profile table using spline interpola- 
tion. A first derivative of the interpolated cam position 
profile is calculated 36 using the cam position profile table 
with spline interpolation. A second derivative of the inter- 

40 polated cam position profile is calculated 38 from the first 
derivative of the interpolated cam position profile. A veloc- 
ity compensation command is calculated 40 by multiplying 
the first derivative of the interpolated cam position profile by 
the cam shaft velocity. A current compensation command is 

45 calculated 42 by multiplying the second derivative of the 
interpolated cam position profile by the square of the cam 
shaft velocity. The position command, the velocity compen- 
sation command and the current compensation command are 
written 44 to controllers to control position, velocity, and 

50 current respectively. 

A block diagram of a control system 50 according to 
flowchart 30 is shown in RG. 3. Cam shaft position 52 
within one cam shaft revolution and cam shaft velocity 54 
from the encoder interface are apptied to control apparatus 

55 50. A cam position command 56 is calculated from a cam 
position profile table 58 using spline interpolation. An 
internal representation of the cam profile data (defined by 
the user) are in cam position profile table 58 in addition to 
preprocessed interpolation coefficients. A difference 

60 between the cam position command 56 and ciurrent motor 
position data 60 is calculated and sent to position control 
block 62 to control cam position. 

A first derivative 64 of the cam position profile is calcu- 
lated using cam position profile table 58 with spline inter- 

65 polation. A second derivative 66 of interpolated cam posi- 
tion profile is calculated from the first derivative 64 of the 
cam position profile. A velocity compensation command 68 
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is calculated by multiplying 70 the first derivative 64 of the loaded with a cam position profile table, a digital servo 
campositionprofiletableSfibycamshaftvelocity 54. Anet controller to perform motion equivalent to a mechanical 
commanded velocity is the sum of an output of the position cam, an encoder, and a control program, said method corn- 
control block 62 and the velocity compensation command prising the steps of: 

68 minus current motor velocity data 72 and is sent to a 5 importing cam shaft position and cam shaft velocity from 

velocity control block 74 to control cam velocity. an encoder interface; 

A current compensation command 76 is calculated by calculating a cam position command; 

multiplying 78 the second derivative 66 of the cam position calculating a first derivative of the cam position profile; 

profile table 58 by the square 80 of the cam shaft velocity 54. calculating a cam servo velocity compensation command 

A net commanded current is the sum of an output of the by multiplying the first derivative of the cam posiUon 

velocity control block 74 and the current compensation P"^^^^ velocity; and 

command 76 minus current motor current data 82 and is sent sendmg a cam position command and a cam shaft velocity 

to a current control block 84 to control cam servo current. ^ compensation command to the digital seivo controUer 

. . r. , , 1. HA r 2. A method according to claim 1 wherein said step of 

HG. 4 shows a fimcUonal Wock diagram cam ealculating a cam posiuon command further comprises the 

servo control system 50 m FIG. 3 bavmg addiUonal correc- ^^^^^ ^ ^^^^^ command from the cam 

Uon from a cam shaft acceleration 92. Cam shaft accelera- position profile table 

tion 92 is generated by taking a derivative of the cam shaft 3 ^ ^^^^^^ according to claim 1 wherein said method 

velocity 54^ Cam shaft acceleraUon 92 is multip led 94 by ^^^^^ comprises the step of calculating a second derivative 

the second denvativc 66 of the cam position profile table 56 position profile. 

providing an additional acceleraUon factor 96. Additional ^ ^ ^^^^^^ according to claim 3 wherein said method 

accelerauon factor 96 is added to the current compensation ^^^^^^ comprises the step of calculating a current compen- 

command 76 resultmg m an adjusted current compensation -^^ command by multiplying the second derivative of the 

command 98, Net commanded current is the sum of an .^^^ ^ ^^^^ ^^y^^- 

output of the velocity control block 74 and the adjusted 5. A method according to claim 4 wherein said method 

current compensation command 98 mmus current motor further comprises the step of sending a current compensation 

current data 82 and is sent to current control block 84 to command to a controller. 

control cam current Such system is suitable for appUcations ^ ^ ^^^^^^ according to daim 1 wherein said step of 

where cam shaft velocity 54 is varying and adjusted current calculating a cam position command from a cam position 

compensauon command 98 has substantial impact on the q^^^ ^^^le further comprises the step of using a spUne 

motion accuracy. interpolation. 

FIG. 5 shows a functional diagram 100 for the cam servo 7, ^ method according to claim 1 wherein said method 

system 50 of FIGS. 3 and 4 with an additional current further comprises the step of calculating a first derivative of 

compensation factor. The combination of cam shaft position cam shaft position for velocity detection. 

102 and adjusted current compensation conmaaod 98 g a method according to claim 7 wherein said method 

together with table 104 produces a correction factor 106. In further comprises the step of calculating a second derivative 

one embodiment, con-ections due to varying load of the cam of ^j^^ ^am shaft position for acceleration detection, 

are defined by table 104. In an alternative embodiment, table 9^ ^ method according to claim 8 wherein said method 

104 is replaced by a formula g(x). Net commanded current further comprises the step of multiplying the second deriva- 

is the sum of an output of the velocity control block 74 and tjve of the cam shaft position by the second derivative of the 

correction factor 106 minus current motor current data 82 cam position profile to determine a cam servo current 

and is sent to curreat control block 84 to control cam servo compensation value. 

current. XO. A method according to claim 1 wherein said method 

FIG. 6 shows an alternative system diagram 110 for the further comprises the step of calculating a first derivative of 
cam servo system 50 shown in FIGS. 3, 4, and 5. In system 45 the cam shaft velocity for current compensation. 

110, cam position profile table 58 (shown in FIGS. 3, 4, and 11. A method according to claim 10 wherein said method 

5) and current correction table (not shown) has been further comprises the step of multiplying the first derivative 

replaced by a cam position profile formula 112. Cam posi- of the cam shaft velocity by the second derivative of the cam 

tion profile formula 112 provides a cam position formula position profile to determine a cam servo current compen- 
command 114 lo be used in calculating compensation factors 5Q sation value, 

and derivatives for the systems in FIGS. 3, 4, and 5 in place 12. A method according to claim 4 wherein said step of 

of the cam position profile table 56. calculating a current compensation command further com- 

The cam control system described herein delivers high prises the step of adding additional current compensation 

performance and accurate results using a velocity and from a current compensation table, 
torque/current feed forward compensation technique opti- 55 13. A method according to claim 1 wherein said step of 

mized for cam characteristics. The system uses different calculating a cam position command further comprises the 

methods than known systems and therefore is significantly step of selecting a formula to generate the cam position 

simpler for a user to program and requires smaller amounts command. 

of data to be stored than existing systems. 14. A method according to claim 4 wherein said step of 
WhUc the invention has been described in terms of 60 calculaUng a current compensation command further com- 

various specific embodiments, those skilled in the art will prises the step of adding additional current compensation 

recognize that the invention can be practiced with modifi- ^om a formula. 

cation within the spirit and scope of the claims. 15. An electronic cam servo control system comprising: 

What is claimed is: an encoder; 

1. A method for conU-olling cam servo motion in an 65 a processor configured to: 

electronic cam servo control system, the electronic cam import a cam shaft position and cam shaft velocity 

servo control system including a processor, a memory acquired from said encoder; 
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calculate a cam position command; 

calculate a first derivative of the cam position profile; 

calculate a cam servo velocity compensation command 
by multiplying the first derivative of the cam position 
profile by the cam shaft velocity; and S 

send a cam position command and a cam velocity 
compensation command to a digital servo controller; 
a memory to store cam position profile, cam shaft position 

and cam shaft velocity acquired by said processor and 

calculation results of said processor; and 
a digital servo control module to receive and perform cam 

position and velocity commands generated by said 

processor. 

16. A system according to claim 15 wherein said proces- 
sor is further configured to calculate a cam position com- 
mand firom a cam position profile table located in said 
memory. 

17. A system according to claim 15 wherein said proces- 
sor is further configured to calculate a second derivative of 
the cam position profile. 

18. A system according to claim 17 wherein said proces- 
sor is further configured to calculate a current compensation 
command by multiplying the second derivative of the cam 
position profile by the square of the cam shaft velocity. 

19. A system according to claim 18 wherein said proces- 
sor is further configured to send a current compensation 
command to said digital servo control module. 

20. A system according to claim 15 wherein said proces- 
sor is further configured to calculate a cam position com- 
mand from a cam position profile table using a spline 
interpolation. 
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21. A system according to claim 15 wherein said proces- 
sor is further configured to calculate a first derivative of the 
cam shaft position for velocity detection. 

22. A system according to claim 21 wherein said proces- 
sor is further configured to calculate a second derivative of 
the cam shaft position for acceleration detection. 

23. A system according to claim 22 wherein said proces- 
sor is further configured to multiply the second derivative of 
the cam shaft position by the second derivative of the cam 
position profile to determine a cam servo current compen- 
sation. 

24. A system according to claim 15 wherein said proces- 
sor is further configured to calculate a first derivative of the 
cam shaft velocity for acceleration detection. 

25. A system according to claim 24 wherein said proces- 
sor is further configured to multiply the first derivative of the 
cam shaft velocity by the second derivative of the cam 
position profile to determine a cam servo current compen- 
sation. 

26. A system according to claim 15 wherein said proces- 
sor is further configured to calculate a current compensation 
command by adding additional current compensation from a 
current compensation table. 

27. A system according to claim 15 wherein said proces- 
sor is further configured to calculate a cam position com- 
mand by selecting a formula to generate the cam position 
command. 

28. A system according to claim 15 wherein said proces- 
sor is further configured to calculate a current compensation 
command by adding additional current compensation from a 
current compensation formula. 

* * * * 
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